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© A manual teaching control device for operations In an Industrial robots-system. 

© According to a control teaching device, position and attitude of tool (2n) on tool handling robot (2) can be 
taught by means of manual operations, being subjected to the movement of position and attitude of workpiece 
(1m) on workpiece handling robot (1), so that relative position and attitude of tool (2n) against workpiece (1m) 
can be kept constant. Position and attitude of workpiece handling robot (1) and tool handling robot (2) are 
computed by use of "actuating signals" of a teaching key means (12) and a "co-acting signal" of a selecting 
means for sole-action/co-action (9) . Then, joint variables of workpiece handling robot (1) and tool handling robot 
(2) are calculated. Actuating values for actuators (17W. 17T) of workpiece handling robot (1) and tool handling 
robot (2) are synchronously outputted after the lapse of time comes into a predetermined infinitesimal time AT, 
therefore, tool (2n) is synchronously co-acted with workpiece (1m). 

FIG. 1 



o 

? 



CM 

in 



ai 




Rank Xerox (UK) Business Services 



BNSOOCID: <£P 0S21«0Aa..l..> 



EP 0 521 440 A2 



TECHNICAL FIELD OF THE INVENTION 

The present invention related to a teaching control device for manual operation In an industrial-robots, 
more particularly, to an industrial robot-equipment enables to be taught by manual teaching operation] 
5 which is provided with a workpiece handling robot that is capable to change "position and attitude* of 
workpiece held in an end effector, such as a robot hand etc. and a tool handling robot that is capable to 
change "position and attitude" of tool processing said workpiece. 

BACKGROUND OF THE PRIOR ART 

10 

The industrial-robots composed of a workpiece handling robot and a tool handling robot provided with a 
tool, such as a machining tool, a welding torch or a welding gun etc.. are generally controlled with co- 
operation by means of method of teaching playback so as to replay movement of both robots at the samo 
time in real processing operations. 
>5 Teaching operations for the robot have to be performed before real processing operations. Teach 
working for both robots are subjected to sole-acting manual operation respectively. 

Referring to Fig. 24(a) of the prior art, first, desired positioning for each robot are independently 
achieved by means of separating movement of workpiece 1m on the workpiece handling robot 1 from 
movement of tool 2n on the tool handling robot 2. The point of A in the "position and attitude", which are 
20 established by the above-mentioned independent movement, is taught as a teaching point of the first 
positioning. This means that the data of "position and attitude" of tool 2n against workpiece 1m at the point 
A and the data of "joint variables" of workpiece handling robot 1 are memorized in a computer. 

Thereafter, tool 2n and workpiece 1m have to be moved according to commands of an operator in order 
to obtain the second positioning. When the workpiece 1m is moved by means of movement of workpiece 
25 handling robot only as shown by a broken line after teaching point A of the first positioning, the workpiece 
1m often contacts with or collides the tool 2n. Therefore, it is necessary to avoid the interference of 
workpiece 1m with tool 2n each other. 

An operator needs to command once retiring tool 2n from workpiece 1m as shown in Fig, 24(b), after 
teaching point A at the first positioning. 
30 Next, the workpiece 1m is moved to the direction of an arrow 1p by means of movement of workpiece 
handling robot 1 as shown in Fig, 24(c) in order to obtain a desired position for a next teaching point B. As 
shown in Fig. 24(d), the point B is taught at the second positioning which is established by means of 
returning tool 2n to workpiece 1m according to movement of tool handling robot 2, 

It is very inconvenient to retire the tool from the workpiece in the middle of teaching operations as 
35 mentioned above. Especially, teaching many points forces increase of the number of times for retiring the 
tool from the workpiece. As a result, it takes a lot of time in order to retire the tool and to return it, causing a 
problem that the teaching time is, on the whole, prolonged. 

Futhermore, an operator often loses sight of a desired next teaching point on the workpiece, when the 
distance between a teaching point and a next one is short or when an arrangement of a series of teaching 
40 points is complicated. 

The first objects of this invention is to enable subjecting tool on tool handing robot to movement of 
workpiece on workpiece handling robot by means of co-acting each other, when an operator teaches both of 
robots by manual operations. 

The second object is to realize exactly maintaining previous position and attitude of tool against 
46 workpiece without retiring tool from workpiece one by one during teaching operations. 

The third object is to present a teaching control device for simplified manual teaching operations in an 
industrial robots-system which teaching operations can be rapidly performed by means of accurately 
subjecting tool to movement of workpiece. 

50 SUMMARY OF THE INVENTION 

The present invention is relates to an industrial robots-system taught by means of manual teaching 
operations, which is provided with a workpiece handling robot that is capable to change "position and 
attitude* of a workpiece and a tool handling robot that is capable to change "position and attitude" of a tool 
55 for processing said workpiece. and composing; 

a selecting means for sole-action/co-action enables to select sole-acting manual operation that facili- 
tates changing position and attitude of workpiece on workpiece handling robot and changing position and 
attitude of tool on tool handling robot separately, or to select co-acting manual operation that facilitates 
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changing position and attitude of tool on tool handling robot by means of co-acting with changing position 
and attitude of workpiece on workpiece handling robot so that position and attitude of the tool against 
workplece can be always kept constant 

a teaching key means outputs actuating signals for changing position and attitude of workpiece. 
5 a control means for manual teaching operations carries out control according to process mentioned 
after by means of receiving actuating signals from said teaching key means and a co-acting signal from 
said selecting means for sole-action/co-action, and 

said control means for manual teaching operations is a computer carries out controlling function, 
including; 

to the first process consists of picking up actuating signals, and computing position and attitude of 
workpiece handling robot at the starting time of manual teaching operations and position and attitude of tool 
against workpiece at the starting time of manual teaching operations, 

the second process consists of commanding to carry out the third process by moans of estimating the 
state after a preset infinitesimal time when actuating signals in the first process are maintained, and 

rs commanding to return to the first process when actuating signals have already changed into different ones, 
and commanding to terminate teaching operations when all of actuating signals have already vanished. 

the third process consists of not only calculating position and attitude of workpiece handling robot but 
previously calculating position and attitude of tool handling robot by use of position and attitude of tool 
against workpiece at the starting time of manual teaching operations, which were calculated at the first 

20 process, and position and attitude of workpiece handling robot at the starting time of manual teaching 
operations, which were calculated at the first process. 

the fourth process consists of not only calculating joint variables of workpiece handling robot by use of 
position and attitude of workpiece handling robot which were calculated at the third process but calculating 
joint variables of tool handling robot by use of position and attitude of tool handling robot which were 

25 calculated at the third process, 

the fifth process consists of not only previously calculating actuating values for actuators of workpiece 
handling robot by use of joint variables of workpiece handling robot which were calculated at the fourth 
process but to previously calculating actuating values for actuators of tool handling robot by use of joint 
variables of tool handling robot which were calculated at the fourth process, in addition, including not only to 

30 synchronously output signals of actuating values for actuators of workpiece handling robot and signals of 
actuating values for actuators of tool handling robot just after an infinitesimal time, but to command 
repeating on and after the second process. 

Said actuating signals of the teaching key means may be adopted the signals commanding translation 
along each axis or rotation around each axis in the cartesian coordinates of position and attitude of 

35 workpiece handling robot. And said actuating signals of the teaching key means may be also adopted the 
signals commanding motions of joints of workpiece handling robot. 

According to the present invention, even if position and attitude of workpiece is changed in order to 
teach a next teaching point from one teaching point, the movement of tool handling robot can be acculately 
subjected to that of workpiece handling robot by means of co-acting each other so that position and attitude 

4o of tool against workpiece at the starting time of manual teaching operations can be always kept constant. As 
a result, it becomes unnecessary to retire the tool from the workpiece in order to avoid interference each 
other, when the workpiece is moved to desired positions. An operator is able to catch the last teaching point 
even when a next point is taught in the state that position and attitude of workpiece have already been 
changed, therefore, enabling rapid and exact teaching of other next points. 

45 

BRIEF DESCRIPTION OF DRAWINGS 

Fig. 1 is a schematic drawing of a teaching control device and a teach pendant in an industrial robots- 
system composing a workpiece handling robot and a tool handling robot, 
so Fig. 2 is a schematic drawing of a workpiece handling robot of 6 degrees of freedom which holds a 
workpiece in an end effector. 

Fig. 3 is a schematic drawing of a tool handling robot of 6 degrees of freedom which installs a tool in an 
end effector. 

Fig. 4 is a schematic drawing of an operation panel of a teach pendant provided with some kind of 
55 changing switches. 

Fig. 5 is a schematic drawing for explanations of homogeneous transformation matrixes which show 
relations of position and attitude between each coordinates for the workpiece handling robot and each 
coordinates for the tool handling robot. 
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of e2'rotot 8 bl0Ck d ' agram ° f 8 C ° ntrol m8anS manua ' ,6aCh,n9 opera,ions which re,a,es to actuators 
Rg. 7 is a flow chart which explains controlling function at the initial phase 
Fig. 8 is a flow chart which explains the motion of "co-acting- 

conu'nLM 3 ng a 8. WhiCh " * ^ """"" <*"*»' 

con^frlV WHiCh WP,ainS ^ ° f «"*•■• manua. operation- 

the te ~- - - — g Path under 

Fig. 12 is a timing chart of each process till all of keys are released. 

Fig. 13 is a schematic drawings for explanations undor the motion of "co-action of position and attitude" 
of the worxpiece handfing robot and the too. handling robot, where (a) shows a s£ afS ^ SSSS 
M shows a state at the positioning after the tool was subjected to a movement *Z^£ZT£Z 
shows a state that a next point is being taught. "orxpiece. ana <c) 

from"VRg S 8 a "°" *"* 0XP ' a ' nS ** ° f C °- 3Ctin9 each •* manual 0Dafa «on" continued 

from"!? of' Rg S "*** 9XP,3inS ** " Vb0 * °' C °- 3CUn9 33Ch 3x18 m3nual •■•««■"" continued 

from"!? of 8 Fig S V" "*** 9XP,ain8 "* n °* °' C °' 3Ctin9 83Ch 3xis ( ™ ua » °P™tion" continued 

from F ?of 1 Fig S 7. *"* "* B °* °' S0 ' e - 3C,in9 axis manual °P ara « 0 "" continued 

from F K of 18 Rg S "'** " m0d9 ° f S ° ,e * 3Ctin9 93Ch ^ manual o^ 0 "" continued 

from^of 1 ^ i a 7 "° W *■* ^ 8XP,ainS ^ " m0de ° f S0,6 - aCtin9 6ach ■* manual «P— ««" continued 

c^l^i: S^ - ** 9XpteinS th9 " m0d ° ° f C3rtesia " c-rdinates manua. operation" 

co^\;L a »:%T ch exp,ains the " mode of sote - actin9 cartesian coordinates m ■ 

contrnLlrl a ^FT20 WhiCh ^ ^ * ^ m3 " Ual 

ooJ^W^^T* eXP,3inS ^ ° f SOte " aC,in9 CarteSia " ~» OP—""- 

Rg 24 is schematic drawings for explanations of the co-operation in the prior art which does not 
associate workpiece handling robot with tool handling robot, i.e.. of "sole-action". where Z shows a s4 a 
me first posihoning. (b) shows a state that too. is retired from workpiece. (c) shows aTtete ftSSiSS J 
being moved to a next teaching point, and (d) shows a state that too. is taught a next £ 

BEST MODE FOR PRACTICING THE INVENTION 

di, c i^ eaC !!i n ? ft .r ,r0 L deViC ! f ° r manUa ' 0p8rati0n in 8n indus,ria ' ^ts-system of the present invention is 
disclosed as follows, by applying it to an embodiment of the welding robots-system which composed of a 
workpiece handling robot and a tool handling robot. composed of a 

and I^l^y 1 !* * tm H kM W " h 3 W ° rkpieC9 handlin9 ^oo* 1 whic " * capable to change "position 
ZZ£^1T?T 38 Sh0Wn in RQ - 2 3nd 3 t00 ' h3ndlinQ «** 2 whic " ^ capable toSange 
£,? 0< 3 t00 ' 2 " f ° r pr0CeSSinfl the work P iece « shown in Fig. 3. Both workpiece 
handling robot 1 and too. hand.ing robot 2 are disposed to be faced each other as shown in Fig 1 and 
so pom and attitude of workpiece ,m and position and attitude of too. 2n required TrZ process^ 
operations, eg ,n the welding operations, can be manually taught before the real processing ope^ons 

The workpiece handling robot 1 which moves a workpiece 1m held in an end effector as a 

obot hand is a manipulator of 6 degrees of freedom which has "joint variables" * to JTSwjXJ to 

ss tLXF* l Tl ' a ,0 " f9Sp6ctive, y- * e ( oo' idling robot 2 which movSTtoo. 2n 

55 ns ailed ,n an end effector 2A is also a manipulator of 8 degrees of freedom which has "joint vanabeT" ? t 
to 66 corresponding to 6 joints 2a to 2f respectively. Each of joints la. 2a etc. indicated by d amonS mark 

STlJ n?^? W SVT S e3Ch ° f ,ink$ 16W '' ,6T ' «° "° direc,i0 " o' an arrowlS Tnd eac^o 
m lb. 2b etc. indicated by double<ircles means a bend-joint which bends each of links 16W, i 6 t" to 
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the direction of an arrow 1B. When some of joints are actuated at the same time, the workpiece and the tool 
can be moved to desired directions respectively, i.e., being moved to the direction of, for instance, X-axis 
only and being rotated around Y-axis only. 

A teach pendant 3 and a control equipment 4 are provided in order to operate workpiece handling robot 
1 and tool handling robot 2. Fig. 4 shows an operation panel of the teach pendant 3, on which an indicating 
device 5 and a stopping switch 6 are disposed. There is a robot changing switch 7 on the right hand side of 
the middle stage of the operation panel for selecting a robot which should be subjected to teaching 
operations, e.g., tiling it up means preparation of movement of workpiece handling robot 1 and tilting it 
down means preparation of movement of tool handling robot 2. 

In the center of an operation panel of the teach pendant is provided a mode changing switch 8 in order 
to select "mode of each axis manual operation" or "mode of cartesian coordinates manual operation". An 
operation changing switch 9 is prepared on tho loft ond of tho operation panel, which is changed to soloct 
"sole-action" of each robot at teach working or "co-action" of both robots at teach working. This switch 
organizes "a selecting means for sole-action/co-action", which facilitates "manual operations of changing 
position and attitude of workpiece 1m on workpiece handling robot 1" and "manual operations of changing 
position and attitude of tool 2n on tool handling robot 2" separately, or facilitates "the manual operation of 
changing position and attitude of tool 2n on a tool handling robot 2" by means of associating with changing 
position and attitude of the workpiece 1m on a workpiece handling robot 1 so that position and attitude of 
the tool 2n against workpiece 1m can be always kept constant. 

Therefore, the above-mentioned "co-action" of both robots at teaching operations means "the manual 
operation of changing position and attitude of tool 2n on a tool handling robot 2 so that position and attitude 
of the tool 2n against workpiece 1m are never changed while position and attitude of the workpiece 1m on a 
workpiece handling robot 1 are being changed" or "the manual operation of changing position and attitude 
of workpiece 1m on a workpiece handling robot 1 so that position and attitude of the workpiece 1m against 
tool 2n are never changed while position and attitude of the tool 2n on a tool handling robot 2 are being 
changed". But the former only is applied to an embodiment in the following description. 

The portion of a scale in the center of the panel is a rate changing switch 10 which is used in order to 
select a desired rate for the movement of a workpiece 1m during the teach working so as to move it more 
slowly than a preset maximum value of a velocity table. 

When a scale of, for example. 0.5 is selected* workpiece 1m can be moved at a half speed to the 
position which is taught by an operator. If the workpiece is required to move quickly, the scale of 1.0 is 
selected by an operator. Any rate may be selected during teaching operations. When the path from a 
present teaching point to a next one is rather long, the rate of, e.g., 1.0, is used till 80 % of said path and 
the rate of 0.1 is used during 20 % left thereof. As a result, workpiece 1m Is quickly moved till the vicinity 
of the target, and it is slowly moved close by said target, by which it will be able to be accurately stopped 
at the target in a short time. Overshooting the target owing to selecting a higher rate, an operator has only 
to command returning to the target. It is convenient for a lower rate to relieve the tension of a teaching 
operator who tries to just stop the workpiece at the next teaching position. Therefore, the rates of this 
embodiment are provided with 4 of, e.g., 0.1, 0.2, 0.5, 1.0. 

In the tower stage at the left hand side of the panel is provided an editing device 11 for teaching data. A 
group of keys 12 is disposed at the right hand side of the editing device. Each of keys 12a - 12f, 12A ~ 
12F generates an output signal of "1", when it is pressed, and generates a signal of "0" when released. 
This group of keys 12 which consists of 12 push-buttons organizes a teaching key means which generates 
"actuating signals" for teaching operations. 

Such a group of keys 12 is explained as follows; In the state that the mode changing switch 8 has been 
selected to "mode of each axis manual operation", when the keys 12a - 12f at the left column are pressed, 
each of joints of workpiece handling robot 1 rotates respectively, and when the keys 12A - 12F at the right 
column pressed, each of them reversely rotates respectively. 

On the other hand, in the state that the mode changing switch 8 has been sleeted to "mode of cartesian 
coordinates manual operation", when the keys of the upper three are pressed, movements to the directions 
of X-axis, Y-axis, 2-axis of the world coordinates system 51 respectively as shown in Fig. 5 are performed. 
I.e., pressing the left keys 12a - 12c realizes movement to the positive directions of each axis, and pressing 
the right ones 12A - 12C realizes movement to the negative directions thereof. When the keys of the lower 
three are pressed, rotations to the directions of Euler's angles a, 0, Y of the world coordinates system 51 
respectively as shown in Fig. 5 are performed, i.e.. pressing the left keys 12d - \2\ realizes rotation to the 
positive directions, and pressing the right ones 12D - 12F realizes reverse rotation. 

Such a teaching control device for manual operation in an industrial robots-system consists of a control 
equipment 4 which is provided with a computer 4A as a "control means for manual teaching operations", 
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which carries out a control by means of receiving commands of "actuating signals" from group of keys 12 
and commands of "co-acting signal" from the operation changing switch 9 as shown in Fig. 1. This "control 
means for manual teaching operations" 4A provides, as shown in Fig. 6, a micro-processing unit 14 which 
consists of CPU, ROM and RAM etc. and surbo-drivers 15 which transform output signals of the micro- 

5 processing unit into actuating signals for actuators explained as follows. 

As workpiece handling robot 1 and tool handling robot 2 are manipulators of 6 degrees of freedom 
respectively, the surbo-drivers 15 consist of 12 ones of 15W, - 15W 6 and 1ST, ~ 15T S and actuators 17 as 
electric motors consist of actuators 17VV, - 17W 6 and 17T, - 17T 6 corresponding to each of surbo-drivers 
15 so that they can rotate the links 16W, - 16W; and I6T1 - l6T b connected with the joints of robot 1 and 

to 2. 

The symbol 18W in Fig. 6 is a control cable which connects each of surbo-drivers 15W with the 
corresponding actuator 17W of workpiece handling robot 1, and the symbol 18T is also a control cable 
which connects oach of surbo-drivers 15T with tho corresponding actuator 17T of tool handling robot 2. The 
numeral 19 is an interface which transmits signals of "actuating value for each actuator", i.e., the symbol 
19a indicates an interface for outputting, and 19b indicates a buffer. They have 12 windows corresponding 
to "joint variables" , * 2 . • * " . * of workpiece handling robot 1 and corresponding to "joint variables" 
0i . 02 . * * * , 0g of tool handling robot 2 respectively. 

This "control means for manual teaching operations" 4A includes a control program which carries out 
five processes described as follows; 

The first process is to calculate actuating velocities of workpiece handling robot 1 under the rate V 
selected on the rate changing switch 10 when the commands of "actuating signals" from group of keys 12 
and the commands of a "co-acting signal" from the operation changing switch 9 have been received. And 
this process includes to compute position and attitude of workpiece handling robot 1 at the starting time of 
manual teaching operations, and to compute position and attitude of tool 2n against workpiece 1m at the 
25 starting time of manual teaching operations. 

The second process is to command carrying out the following third process by means of estimating the 
state after a preset infinitesimal time AT, e.g.. one-twentieth of a second when "actuating signals" in the 
first process are maintained. Or this process is to command returning to the first process when "actuating 
signals" have already changed into different ones. Or this process is to command terminating teaching 
30 operations when all of "actuating signals" have already vanished. 

The third process is not only to calculate position and attitude of workpiece handling robot 1 but to 
previously calculate position and attitude of tool handling robot 2 by use of position and attitude of tool 2n 
against workpiece 1m at the starting time of manual teaching operations, which were calculated at the first 
process, and by use of position and attitude of workpiece handling robot 1 at the starting time of manual 
35 teaching operations, which were calculated at the first process. 

The fourth process is not only to calculate "joint variables" of workpiece handling robot 1 by use of 
position and attitude of workpiece handling robot 1 which have were calculated at the third process but to 
calculate "joint variables" of tool handling robot 2 by use of position and attitude of tool handling robot 2 
which were calculated at the third process. 

The fifth process is not only to previously calculate "actuating values for actuators" b*h . . • • • 
a^ of workpiece handling robot 1 by use of "joint variables" of workpiece handling robot ! which were 
calculated at the fourth process but to previously calculate "actuating values for actuators" a,,., , a,*, , • • • 
. aw of tool handling robot 2 by use of "joint variables" of tool handling robot 2. And this process includes 
not only to synchronously output the signals of "actuating values for actuators" a^ , a**., , • • • , a*^ of 
workpiece handling robot 1 and the signals of "actuating values for actuators" a,^ , a^ , * • * a*' ( of tool 
handling robot 2 just after an infinitesimal time AT. e.g.. one-twentieth of a second! but to command 
repeating on and after the second process. 

The "control means for manual teaching operations" 4A provides a program for carrying out the above- 
mentioned "co-action" which associates the change of position and attitude of workpiece im on workpiece 
handling robot 1 with the change of position and attitude of tool 2n on tool handling robot 2. in addition to 
this program, the control means 4A also provides a program carrying out the "sole-action" which acts either 
workpiece handling robot 1 or tool handling robot 2 according to the robot changing switch 7 when "sole- 
action" which does not associate the change of position and attitude of workpiece tm on workpiece 
handling robot 1 with the change of position and attitude of tool 2n on tool handling robot 2 is selected by 
55 the operation changing switch 9. 

Referring to some of flow charts in and after Fig.7, the manual teaching operations of workpiece 
handling robot 1 and tool handling robot 2 in the above-mentioned system related to the present invention 
are described as follows; 
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[ 1 J The "co-acting cartesian coordinates manual operation" is explained below, which is In a state that 
"mode of cartesian coordinates manual operation" is selected by the mode changing switch 8 and "co- 
action" is selected by the operation changing switch 9. This means the referential point 56 of workplace 
Im with respect to the world coordinates system 51 as shown in Fig. 5 is changed into desired position 
and attitude thereof wilhout changing the relative position and attitude between tool 2n and workpiece 
1m. 

An operator chooses "co-action" in the operation changing switch 9. "mode of cartesian coordinates 
manual operation in the mode changing switch 8 and "workpiece handling robot" in the robot changing 
switch 7 on the teach pendant 3. Moreover, a desired rate V. e.g.. 0.2. which is indicated as • r„ " is 
chosen in the rate changing switch 10. 

An operator presses desired keys, e.g., 12b, 12c and 12E. The procedure till they will be released is 
as follows: 

[ a J : The first process consists of the after-mentioned [ a-1 ] to [ a-4 ). 

Actuating signals are inputted to the control equipment by means of pressing keys 12b 12c and 
12E [ see step 1 in the flow chart of Fig. 7, such as ST1 is indicated after this.]. As the operation 
changing switch 9 is "on", i.e.. being selected "co-action" [ ST2 ]. the robot changing switch 7 is 
on^. i.e.. be.ng designated "workpiece handling robot" [ ST3 ] and the mode changing switch 8 is 
on , i.e.. being selected "mode of cartesian coordinates manual operation" [ ST6 in Fig 8 1 the 

T?? ZZ TL t0 St6P ^ " ,he r0bOt Chan9in9 Swi,ch 7 is " ofr - i e - ^"9 designated "^handling 
robot [ ST3 ]. the procedure for controlling later becomes impossible. In this case it is indicated on 
the indicating device that the robot changing switch 7 should be "on", i.e.. a message of designating 
workpiece handling robot" appears in an undrawn CRT etc. [ ST4 ]. the procedure is terminated at 
this time [ ST5 J. 

A workpiece handling robot 1 may be used a manipulator of 6 degrees of freedom or a positioner 
of less than 3 degrees of freedom. A manipulator of 6 degrees of freedom only is. however, applied to 
the control in this embodiment of the present invention, therefore, in step 7 it is discriminated whether 
worfcpiece handling robot 1 is a manipulator of 6 degrees of freedom or not. 

As the degree of freedom of workpiece handling robot 1 is previously stored in "control means for 
manual teaching operations" 4A. the discrimination of whether workpiece handling robot 1 is 6 
degrees of freedom is carried out by means of said stored signal. If workpiece handling robot 1 is a 
EE Hf f ; arnossa9e> that ,he P r «*°"re for controlling later is impossible is indicated in an undrawn 
CRT etc. [ ST8 1, the procedure is terminated at that time ( ST9 J. 

The program includes a protective program to prevent a reckless operation of the computer, so 
that cartesian coordinates manual operation" may become impossible unless workpiece handling 
robot 1 is 6 degrees of freedom. As a positioner is generally less than 3 degrees of freedom 
cartesian coordinates manual operation" can not be carried out. but said positioner is capable to be 
carried out by means of "mode of each axis manual operation" only mentioned later. If the workpiece 
handling robot 1 is 6 degrees of freedom [ ST7 ], the procedure is led to step 10 
[ a-1 J; Velocities for translation and rotation of the referential point 56 of workpiece 1m in the absilute 
coordinates system 51 are calculated as follows; 

The velocities Vx. .Vy Wf V2w ,Va w .V/} w ,v 7w are computed by use of actuating signals Sx . Sy . 
v ' v ' 96nerated by ke * s 12b - 12c «* 12E > a designated rate "r b " and maximum values 
vxwo . v yw0 , Vz,* , v a ^ , v/}^ . V 7w0 memorized in a velocity table for "cartesian coordinates 
manual operation" of workpiece im [ ST10 ], from equations (1). 

Vx» = Sx x r b x Vxwo 
Vy w = Sy x r„ x Vy^ 
Va, = Sz x r h x Vz,*, 
Vo„ = Sa x r 0 x V Qw0 
V&, = S0 x r b x V^ 
V 7 w = S-,- x t b x V 7w0 (i) 

The above-mentioned Sx. Sy .'* • • ,S> are as follows; 
pressing each of keys 12a - I2f produces a signal "-M" for each output; 
pressing each of keys 12A - 12F produces a signal "-1" for each output- 
releasing each of keys 12a - 12f. 12A - 12F produces a signal "0" for each output. 
Since keys 12b. 12c and 12E only are pressed in this example, 
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Sx - 0. thus, Vx* * 0 
Sy = ♦ l, thus, Vy w = r b x Vy^ 
Sz = + 1, thus, V2 W = r b x VZwo 
So = 0, thus. Va w = 0 

= - 1, thus, V0 W = - r b x 
Sy = 0, thus, V 7w = 0 



[ a-2 ] ; Position and attitude of workpiece handling robot 1 at the starting time of manual teaching 
operations are calculated by use of actuating signals as follows; 

"Joint variables'* 4h-o, $2-0, • • * * . $6-0 of workpiece handling robot 1 at the starting time of 
manual teaching operations aro inputted [ ST11 J. Position and attitude W 2 - 0 of the holding point 53 
of workpiece 1m with respect to tho base point 52 of workpiece handling robot 1 is formulated as 
equation (3), by a product of homogeneous transformation matrixes of equation (2) which uses "link 
parameters" indicated by Denavit-Hartenberg notation. 

Aj w = Rot(Z, 4>j) • Trans(a iw , 0, d, w ) • Rot(X, a jw ) (2) 

W2-0 = A, w • A** • A^ • A4 W * Ag w • Ae w (3) 

The simbols in equation (2) are as follows; 
4j is a variable of j-th Joint of workpiece handling robot 1. 
aj w is a length of the j-th link of workpiece handling robot 1 . which is a fixed value, 
djw is a distance between the G-1)-th link and the j-th one of workpiece handling robot 1. which is 
a fixed value. 

o|w is an angle between the (H)-th link and the j-th one of workpiece handling robot 1. which is a 
fixed value. 

[ a-3 ] ; Position and the attitude of the tip point 57 of tool 2n with respect to the referential point 56 of 
workpiece 1m at the starting time of manual teaching operations are calculated. 

"Joint variables" 0i -10 , 02-0 , * * * , 0g-o of tool handling robot 2 at the starting time of manual 
teaching operations are inputted [ ST12 ]. Position and attitude T 2 - 0 of the installation point 55 of tool 
2n with respect to the base point 54 of tool handling robot 2 is formulated as equation (5), by a 
product of homogeneous transformation matrixes of equation (4) which uses "link parameters" 
indicated by Denavit-Hartenberg notation. 

Aj t ■ Rot(Z, 0j ) • Trans^, 0. d n ) " Rot(X, a Jt ) (4) 

T 2 - 0 = A tt ' A* • Aa, " A* t " A* • A* (5) 

The simbols in equation (4) are as follows; 
6j is a variable of the j-th joint of tool handling robot 2. 
aj t is a length of the j-th link of tool handling robot 2. which is a fixed value, 
dj, is a distance between the (j-1H n link and the j-th one of tool handling robot 2. which is a fixed 
value. 

aj, is an angle between the (j-1Hh link and the j-th one of tool handling robot 2, which is a fixed 
value. 

A homogeneous transformation matrix " world X*^ n of position and attitude of the referential 
point 56 of the workpiece with respect to the world coordinates system 51 as shown in Fig. 5 is 
calculated by equation (6) [ ST13 J. 

world X*.o = Zw • W2-0 * E w (6) 

where Z w is a homogeneous transformation matrix of position and attitude of the base point 52 of 
workpiece handling robot 1 with respect to the world coordinates system 51 of Fig. 5, and Ew is a 
homogeneous transformation matrix of position and attitude of the referential point 56 of the workpiece 
with respect to the holding point 53 of workpiece 1m. These data are previously stored in the "control 
means for manual teaching operations" 4A, 

A homogeneous transformation matrix " world X,^ " of position and attitude of the tip point 57 of 
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tool 2n with respect to the world coordinates system 51 is calculated by equation (7) [ ST14 ]. 
world = Z, • T 2 - 0 • E, (7) 

where Z< is a homogeneous transformation matrix of position and attitude of the base point 54 of tool 
handling robot 2 with respect to the world coordinates system 51, and E, is a homogeneous 
transformation matrix of position and attitude of the tip point 57 of the tool with respect to the 
installation point 55 of tool 2n. These data are also previously stored in the "control means for manual 
teaching operations" 4A. 

Assuming that a homogeneous transformation matrix of position and attitude of the tip point 57 of 
tool 2n with respect to the referential point 56 of the workpiece is • wX, a following equation is 
formulated. 

world X 1K) = world X*^ • wX, (8) 

Therefore, wX, is calculated by equation (9) [ ST15 in Rg. 9 ). 
wX, = ( world X^ ) -i • ( world X^ ) (9) 

A homogeneous transformation matrix " world x^o " of position and attitude of the referential 
pant 56 of workpiece 1m with respect to the world coordinates system 51 is formulated as a followinq 
equation. 



25 
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world Xw-o = 



n x 


0 x 


a x 


P X 


n y 


O y 


a y 


P y 


n > 


0 z 


a , 


P z 


0 


0 


0 


1 



(10) 
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By transforming the above equations, the data for position X w ^ , , Z w „ and the data of 
tuier s angles a WK> , ^ , ywH3 for attitude of the referential point 56 of the workpiece with respect to 
the world coordinates system 51 at the starting time of manual operations are obtained The 6 
equivalent parameters are calculated by means of following equations [ ST16 J. 
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world X„-o ~Trans(Xw-o , Y*. d . Z H -o ) -Rot(Z> a w -o ) 

• Rot( Y • 0 w -o ) • Rot(Z. r w-Q ) 



Cos(arw-o ) Cos(0«- o ) Cos(r*-o ) -Sin(cr w - 0 ) Sin(rw-o ) 

Sin(or w -o ) Cos(£ w -o ) Cos(rw-o ) + Cos(*w- 0 ) Sin(r«-o ) 
- Sin ( 0 w-o ) Cos ( r w-o ) 
0 



-Cos(a„-o ) Cos(0 w -o ) Sin(r*-o ) 
Sin(cr w -o ) Cos(£ w - 0 ) Sin(r*-o ) 
Sin(y? w-o ) Cos( r w-o ) 
0 



- Sin( ar w-o ) Cos( r 
-Cos(a w -o ) Cos( r 



w-o ) 
w-o ) 



Cos(ofw_ 0 ) Sin(£w-o ) 
Sin(afw-o ) Sin(£w- 0 ) 
Cos(0w- o ) 
0 



X w- o 
Yw-O 

1 



Xw-O = P* . Y W -0 = , Zw^ = P, (11) 

= Cos- 1 (a* /Sintfw* ) ) (12) 
Ah, = Cos- 1 (a, ) (13) 
7wo - Sin"* 1 (o 2 /SinOVo ) ) (14) 



[ a-4 ] ; Setting up i = 0, and a lapse of time A t-i from the starting time of manual operations is set 

equal to "0" [ ST17 J. 

[ b ) : The second process is as follows; 

The discrimination of whether keys 12b, 12c and 12E previously pressed have been released or 
not, i.e, ; whether actuating signals are maintained or not, is carried out [ ST18 J. If all of actuating 
signals are maintained, a infinitesimal time AT is added to the (apse of time A u [ ST19, ST20 ], and 
carrying out the third process is commanded after the lapse of time is replaced with A t + i . If all of 
keys 12b, !2c and 12E have already been released [ ST21 in Fig. 9 ], the teaching operation is 
terminated [ ST22 ). If the keys have been pressed are different from previous ones, i.e., keys 12a, 
12D and 12E have already been pressed instead of keys 12b, 12c and 12E [ ST21 J, the procedure is 
repeated from step 1 of the first process by use of new actuating signals thereof, 
[ c ] : The third process is as follows; This is carrying out by receiving the command from the second 
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process. 

Position X^i , , Z+t and Euler's angle o w ., , fa , y ^ of attitude of the referential point 56 of 
workplece 1m with respect to the world coordinates system 51 after the lapse of time A . i e after 
ATxi, are calculated [ ST23 in Fig. 10 J. H ' ' 

X*m = ♦ Vx* 1 x A Li 
Y^i ■ + Vy w x A t| 
Zw., = Zw^ + Vz* x A U 

0w4 n + V/^ x A It 

Yw-. = 7w« ♦ V 7w x A t, (15) 

A homogeneous transformation matrix - world - of position and attitude of tho referential 
point 56 of workplace 1m is calculated by equation (16) [ ST24 J. 

world X*, * TransfX*, , Y w . ( . fa ) • Rot(Z. ) • Rot (Y. fa ) • Rot(Z, ywA ) (16) 

Even if workpiece 1m acts according to equation (16), position and attitude T 24 , which relative 
position and attitude of tool 2n against workpiece 1m are never changed, of tool handling robot 2 are 
calculated. 

A following equation is formulated as the above-mentioned equation (8). 
world X,., b world X^ • wX, (17) 

A following equation is formulated from the relation of coordinates as the above-mentioned 
equation (7). 

world X« = Z t • J 2A • E, (18) 

From equation (18), a following equation (19) is formulated. 

T 2 -i = (Zt) - 1 • world X w • (E,) (19) 

Substituting equation (17) into equation (19) results equation (20) [ ST25 ]. 
1 2A = (2,) • world X*., • wX, • (E t ) (20 

On the other hand, equation (21) is formulated as an above-mentioned equation (6). 
world Xw., = Z w • W 2 .« • Ew (21) 

and a homogeneous transformation matrix W 2 , of position and attitude of workpiece handling robot 1 
can be calculated by equation (22) [ ST26 J. 

W 2 . t = (Zw ) -i • world X w . { • (E w ) (22) 

[ d ] : The fourth process consists of the following [ d-1 ] to [ d-2 J. 

[ d-1 ] ; "Joint variables" 9 U . Ha , • • • , e w ot tool handling robot 2 are obtained by inversely 
transforming T 2 ^ of equation (20) [ ST27 ]. ' y 

J d-2 J : "Joint variables" # w , * 2 , , • • - , * 6 , 0 f workpiece handling robot 1 are obtained by 
inversely transforming W 24 of equation (22) [ ST28 J. 
[ e ]: The fifth process is as follows; 

Actuating quantities of "joint variables" per unit of "actuating values for actuators" of tool handlina 
robot 2 and workpiece handling robot 1 respectively are assumed R M , R, 2 , • • • , R lfl r w1 ^ • 
* . R^6. which are predetermined values every robot and are previously stored in the "control 
means for manual teaching operations" 4A. 

Assuming that actuating values for actuators 17T, , 17T 2 . • • • B 17T 6 of tool handling robot 2 

11 



,0521440A2_l.> 



EP0521440A2 

are an-* , a, 2 -i , * • * , a, e * and actuating values for actuators 17Wi , 17W 2 , • • # , 17W*of 
workpiece handling robot 1 are a*,., . a^ 4 . • ■ • . a^n, they are as follows [ ST29 J; 

a,n = $ u f Rn 

5 Qi2A = *w Ha 

a^ = 634 /R l3 

a^i = 644 'Rt4 

atw «* e 5 H / R, 5 

10 a, w - 0 6 .i He (101) 

9wH = $1-1 /Rwl 
aw3-4 = ^3-1 /R*3 

a*e-i = ♦w/R*© (102) 



0 20 Such actuating values a, M , , • • # , a, w for actuators of tool handling robot 2 and actuating 

values awi.i . a^ , • • • , a**, for actuators of workplace handling robot 1 are outputted just after the 

1 lapse of time comes into ATxi [ ST30. ST31 ] . and the procedure is returned to step 18 of the 
second process. 

The control function by means of the "control means for manual teaching operations" 4A. which 
25 includes an algorithm thereof, are described above. An example of actual teaching operations is explained 
I referring to Fig. 11(a) as follows; In the case that position and attitude of a teaching point At at the first 

postioning on workpiece 1m indicated by a solid line is moved to that of a teaching point A* at the second 
postioning thereon indicated by a single dotted line, an operator has only to press, e.g., once, a group of 
keys 12, if the path from the first teaching point A1 till the next one A2 is simple. In this operation, step 18 is 
30 repeated every after adding AT, e.g., one-twentieth of a second [ ST19. ST20 ]. The workpiece 1m and tool 
I 2n are moved according to the output signals of step 31 every said repetition. 

The process is repeated till ATxn every AT as shown in a timing chart of Fig. 12. The repetition from 
the second process till the fifth process every AT is comprehensible. The intervals of AT in Rg. 11(a) are 
indicated different each other, because workpiece 1m is not always moved same distance every AT and 
35 attitude of workpiece 1m is often changed three-dimensionally. 

When the state which keys 12a, 12c and 120 are pressed is changed to the state which keys 12a and 
I 12F are pressed, actuating signals are changed as a broken line indicated at the upper part of a timing 

I chart in Fig. 12. Even if actuating signals are changed as above, the procedure is returned to step 1 from 

I step 21, as long as all of signals are not "0". The procedure is carried out till step 31 according to actuating 

I 40 signals changed as above. In this case, actuators 17W, 17T actuate n times from the first ATxi till the last 

ATxn. 

I What all of actuating signals have changed to "0" at step 21 means unnecessity of moving workpiece 

I 1m, and the controlling function is completed at a finishing point EE in the timing chart. After this, "co- 

action" is futhermore repeated or "sole-action" is carried out from step 2 as mentioned later. 
45 The case that the above-mentioned "co-action" is repeated in spite that all of actuating signals have 
already changed to "0" means a case that position and attitude of tool 2n against workpiece 1m do not still 
become desired position and attitude thereof at the second positioning. In this case, the above-mentioned 
procedure is continued till the second positioning is completed. Such an example is bliefly described as 
follows; 

50 If the path between point Ai at the first positioning and point A* at the second positioning is straight and 
long, a rate changing swicth 10 is preferable to be changed as follows. The point ai and at are chosen in 
the middle of the path between point At and point A2 as shown in Fig. 11(b). The rate of 1.0 is selected in 
5 the route from point A^ till a,. 0.5 from point at till a?, 0.1 from point a? till As. Each of points ai , a? , A? 

corresponds to the finishing point EE in Fig. 12 respectively. Position and attitude at a temporary point a\ 
56 are ignored and are not memorized after arriving at a next temporary point of a2- Similarly, position and 
attitude at the temporary point a 2 are also ignored. On the other hand, position and attitude at the point A 2 
are memorized as teaching data. 

Therefore, directly moving from point Ai to A? is played back at the rate of 1.0 in real processing 
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operations of. for example, in the welding operations, so as to keep position and attitude of tool 2n against 
workpiece im at the starting time of manual operations. When the rate has been set up to a lower value in 
the final route from above-mentioned point a, till point As, it may be prevented from carelessly overshooting 
the target A? and it may be promoted to relieve the tension of a teaching operator. 

In the case that there Is a protrusion on Uie way from point A i to A? on workpiece 1m. the route lor 
point A? should be avoided it. The route via points a, and a? which do not exist on the segment A, Aj 
| .nd.cated by a broken line in Fig. 11(c) is selected for a teaching path, tn this case, not only "mode of 

|| cartesian coordinates manual operation" may be adopted between point A, and a, but "mode of each axis 

manual operation- mentioned later may be adopted between point a, . and a*. moreover, "mode of cartesian 
coordinates manual operation" may be adopted again between point a ? and Aj. Each of points a, fe A, 
corresponds to the finishing point EE in Fig. 12. When "mode of each axis manual operation" is adopted 
between the point a, and a?, it is also possible to change tho rate at the point of a, , in the middle of the 
route between a> and aj. 

The state of the starting time of manual operations means the state of the first positioning as shown in 
F,g. 13(a), therefore, the teaching point A is a point A,. The state of the second positioning is achieved via 
points a,, a* etc. by means of rotating workpiece 1m to the direction of the arrow 1 P . The second 
positioning at the point Az is shown in Fig. 13(b). The "co-action" is carried out between Fig 13(a) and F.g 
13(b). After the teaching point A is shifted to point As at the second positioning, the next teaching point B 
and the point C after next shown in Fig. 13(c) may be taught by means of "sole-acting manual operation" 
l.e.. moving tool 2n under the condition that workpiece 1m is stopped, or moving workpiece 1m under the 
condition that tool 2n is stopped. 

The above-mentioned description in Fig. 13 is comprehensible differenl from that of the prior art in Fig 
24. This means that tool 2n never leaves workpiece 1m between Fig. 13(a) and Fig. 13(b) tool 2n is 
subjected to the movement of workpiece 1m, and position and attitude of tool 2n against workpiece 1m are 

ahuauc maintainor! 
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[ 2 J Next, "co-acting each axis manual operation" is explained below, which is in a state that "mode of 
each axis manual operation" is selected by the mode changing switch 8 and "co-action" is selected by 
the operation changing switch 9. This means that position and attitude of workpiece 1m are changed to 
desired ones thereof by means of joints of workpiece handling robot 1 without changing relative position 
ao and attitude between tool 2n and workpiece 1m. 

An operator chooses "co-action" in the operation changing switch 9. "mode of each axis manual 
operation" in the mode changing switch 8 and "workpiece handling robot" in the robot changing switch 7 
on teach pendant 3. Moreover, a desired rate "r". e.g.. 0.5. which is indicated as "r c ". is chosen in the 
rate changing switch 10. 

35 An operator presses desired keys, e.g., 12b and 12D. The procedure till they will be released are as 

follows; 

[ a ] : The first process consists of the after-mentioned [ a-1 ] to [ a-4 ]. 

Actuating signals are inputted into control equipment by means of pressing keys 12b and 12D [ 
ST1 in Fig. 7]. As the operation changing switch 9 is "on", i.e., being selected "co-action " [ ST2 ] the 
ao robot changing switch 7 is "on\ i.e., being designated "workpiece handling robot" [ ST3 in Fig 7 ] 

and the mode changing switch 8 is "off", i.e.. being selected "mode of each axis manual operation" [ 
,n R 9-8 1 procedure is led to step 32 in Fig. 14. If the robot changing switch 7 is "off" i e 
being designated "tool handling robot" [ ST3 ], the procedure for controlling later becomes impos- 
sible. In this case it is indicated on the indicating device that the robot changing switch 7 should be 
as "on", i.e., a message of designating "workpiece handling robot" appears in an undrawn CRT etc [ 

ST4 ], the procedure is terminated at this time [ ST5 ]. 

A workpiece handling robot 1 may be a manipulator of 6 degrees of freedom or a positioner of 
less than 3 degrees of freedom in this "mode of each axis manual operation". A manipulator of 6 
degrees of freedom only is applied to controlling in the above-mentiond "mode of cartesian 
so coordinates manual operation". But a positioner of 3 degrees of freedom may be also applied to this 

embodiment, then, actuating signals generated by the group of keys 12 are S1 to S3 only. 
[ a-i ]; Velocities for joints of workpiece handling robot 1 are calculated as follows- 

The velocities Vi w .V2* ,V3 W ,V4* ,V5* .V6* are computed by use of actuating signals Si S2 
S3, S4, S5, S6 generated by keys 12b and 12D, a designated rate "r c ■ and maximum values Vi 
55 "° ' V2 *° • V3 *° • V4 *o • V5 wo . V6wo memorized in a velocity table for "each axis manual 

operation" of workpiece handling robot 1 [ ST32 n Fig. 14 ], from equations (23). 

V1 W = S1 * r c x Vl^ 
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V2 W = S2 x r c x V2wo 

V3w = S3 x r c x V3wo 

V4* = S4 x r c x V4*o 

V5w s S5 x r c x V5wo 

V6w = S6 x r c x V6wo (23) 

The above-mentioned 31, S2 , • • • . S6 are as follows; 
pressing each of keys 12a - I2f produces a signal " + 1 " respectively, 
pressing each of keys 12A - 12F produces a signal "-1" respectively, 
releasing each of keys 12a - I2f, 12A ~ 12F produces a signal "0" respectively. 
Since keys 12b and 12D only are pressed in this example, similar to the above-mentiond example. 

V1 W = 0, V3w = 0. V5* = 0, V6w = 0. 



[ a-2 ] ; Position and attitude of workpiece handling robot 1 at the starting time of manual teaching 
operations are calculated by use of actuating signals as follows; 

"Joint variables" $1 - 0 , $2-0. * * * * , *&-o of workpiece handling robot 1 at the starting time 
of manual teaching operations are inputted [ ST33 J. Position and attitude W 2 - 0 of the holding 
point 53 of workpiece 1m with respect to the base point 52 of workpiece handling robot 1 is 
formulated as equation (3A), by a product of homogeneous transformation matrixes of equation 
(2A) which uses "link parameters" indicated by Denavit-Hartenberg notation. 

A, w = Rot(Z. *, ) • Trans(a, w . 0. d^) • Rot(X, a iw ) (2A) 

W»-o = A lw • Aa w • Agw • A4w * As w • A« w (3A) 

Equations of (2A) and (3A) are just the same with above-mentioned equations (2) and (3) 
respectively. And *j , aj w , djw and a M are also the same with the explanations after equations (2) 
and (3). 

[ a-3 ] ; Position and attitude of the tip point 57 of tool 2n with respect to the referential point 56 of 
workpiece 1m at the starting time of manual teaching operations are calculated as follows; 

"Joint variables" 9i-o , $2-0 , * # • , 0 6 -o of tool handling robot 2 at the starting time of 
manual teaching operations are inputted [ ST34 ]. Position and attitude T?-o of the installation point 
55 of tool 2n with respect to the base point 54 of tool handling robot 2 is formulated as equation 
(5A), by a product of homogeneous transformation matrixes of equation (4A) which uses "link 
parameters" indicated by Denavit-Hartenberg notation. 

Aj, = Rot(Z, 0| ) • Trans(aj„ 0, d jt ) * Rot(X. o Jt ) (4A) 

T 2 -c * A 1t • Asm • As, • A*, * A5t • Ae, (5A) 

Equations of (4A) and (5A) are just the same with above-mentioned equations (4) and (5). And <f> } , 
aji , dj t and o Jt are also the same with the explanations after equations (4) and (5). 

A hmogeneous transformation matrix " world X*^ " of position and attitude of the referential 
point 56 of the workpiece with respect to the world coordinates system 51 is calculated as a 
following equation ( ST35 ]. 

world X^ = Z w * W 2 -o • Ew (6A) 

This equation of (6A) is just the same with above-mentioned equations (6). Zw and E w are also the 
same with the explanations after equation (6). 

A homogeneous transformation matrix " world X t ^> " of position and attitude of the tip point 57 
of tool 2n with respect to the world coordinates system 51 is calculated as a following equation [ 
ST36 J. 

world Xh, » Z, • T2-0 • E, (7A) 



14 



...052144OA2J.* 



EP 0 S21 440 A2 



This equation of (7A) is just the same with above-mentioned equations (7). 2 t and E, are also the 
same with the explanations after equation (7). 

Assuming that a homogeneous transformation matrix of position and attitude of the tip point 57 
of tool 2n wiih respect to the referential point 56 of the workpiece is "w^.a followinq equation is 
formulated. 

world «= world • wX, (8A) 

Therefore, wX, is calculated by equation (9A) [ ST37 ]. 

wX, = ( world X^, ) - 1 • ( world X^ ) (9A) 

Equations of (8A) and (9A) are just the same with above-mentioned equations (8) and (Q) 
respectively. ' 

[ a-4 J ; Setting up i = 0, and a lapse of time A t, from the starting time of manual operations is 

set up equal to "0" ( ST38 J. 
[ b ] : The second process is as follows; 

The discrimination of whether keys 12b and 12D previously pressed have been released or not 
».e., whether actuating signals are maintained or not, is carried out [ ST39 in Fig. 15 ) If all of 
actuating signals are maintained, a infinitesimal time of AT is added to the lapse of time A t, [ ST40 
ST41 ), and carrying out the third process is commanded after the lapse of time is replaced with A t 
If all of keys 12b and 12D have been already released [ ST42 J. the teaching operation is 
termmated [ ST43 ]. If keys have been pressed are different from previous ones, i.e. the key 12c has 
been already pressed instead of keys 12b and 12D [ ST42 ]. the procedure is repeated from step 1 of 
the first process by use of new actuating signals thereof. 

[ c ] : The third process is as follows; This is carrying out by receiving the command from the second 
process. "Joint variables" * 14 . *24 . • • • . * w of workpiece handling robot 1 after the lapse of 
time A ti . i.e., after AT x i . are calculated [ ST44 in Fig. 16]. 

*m = *i-o + V1 w x A 
*2A s <t>z* ♦ V2 W x A U 
*3-l s *3-o + V3» x A tj 
* 4>k> + V4* x A t, 
4>ba ■ 4>k> ♦ V5w x A ti 
*w = *6-o + V6* x A ti (24) 

Position and attitude W 2 ., of the holding point 53 of workpiece 1m with respect to the base point 
52 of workpiece handling robot 1 is formulated as equation (26). by a product of homogeneous 
transformation matrixes of equation (25) which uses "link parameters" indicated by Denavit-Harten- 
berg notation [ ST45 J. 

A, w = Rot( z, * H ) • Trans(a^. 0, d |w ) • Rot(x, ajw ) (25) 

W 2 .j « Ai w * A?* * A3W * A** # A^ • Ae w (26) 

The simbols in equation (25) are as follows; 
* H is a variable of j-th joint of workpiece handling robot 1 . 
a^ is a length of the j-th link of workpiece handling robot 1, which is a fixed value. 
d,w is a distance between the (j-1)-th link and the j-th one of workpiece handling robot 1 which is 
a fixed value. 

<V is an angle between the (j-1 Hh link and the j-tn one of workpiece handling robot 1 which is a 
fixed value. 

When workpiece handling robot 1 acts according to equation (26), position and attitude of T 2 , 
which relative position and attitude of tool 2n against workpiece 1m are never changed of tool 
handling robot 2 are calculated. A homogeneous transformation matrix - world X*., - of position and 
attitude of the referential point 56 of the workpiece with respect to the world coordinates system 51 is 
calculated by a following equation. 
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world = 2w • W w • Ew (27) 

And a following equation is formulated as the above-mentioned equation (8). 
world Xh = world X^ • wX, (28) 

A following equation is formulated from relation of coordinates as above-mentioned equation (7). 
world X M * Z, • T 24 • E, (29) 

From equation (29), a following equation (30) is formulated. 
TV, = (Z, ) ~* • world Xh • (E, ) (30) 

Substituting equation (27) into equation (30) results equation (31), thus, T w is calculated [ ST46 ). 
T 2 ., = (Z, ) -> • world X,,, • wX, * ( E, ) ~ 1 (31) 



[ d ] : The fourth process is as follows; 

"Joint variables" 9,., , e 2 -, . ' * * . *e-i of tool handling robot 2 are obtained by inversely 
transforming T 2 _, of equation (31) [ ST47 J. -Joint variables" , fc,., .*••.*»., of workpiece 
handling robot 1 can be obtained by inversely transforming W 2 ., of equation (26). 
[ e ] : The fifth process is as follows; 

Actuating quantities for joint variables per unit of actuating values for actuators of tool handling 
robot 2 and workpiece handling robot 1 respectively are assumed R M , R t2 , • • • , R l8 ,Rwi . R*2 . • 
• • . FU- Actuating values for actuators of tool handling robot 2 are a,^ , a 1JW . • • • , a t6 .i are 
calculated from above-mentioned equation (101), and actuating values for actuators of workpiece 
handling robot 1 are a»n ,aw W( ,,, ) a^j are calculated from equation (102) [ ST48 ]. 

Such actuating values for actuators of tool handling robot 2 and actuating values for actuators of 
workpiece handling robot 1 are outputted just after the lapse of time comes into ATxi [ ST49, ST50 J, 
and the procedure is returned to step 39 of the second process. 

The repetition of each process from generation of actuating signals till vanishment thereof is 
shown in a timing chart of Fig. 12 in the case of "mode of co-acting each axis manual operation". Fig. 
1 1, Fig. 12 and Fig. 13 are also applied to this procedure. 

In the state that workpiece 1m is moved to desired position and attitude by means of "mode of 
co-acting each axis manual operation" or "mode of co-acting cartesian coordinates manual operation", 
if "co-action" is selected by the operation changing switch 9 on teach pendant 3 and "tool handling 
robot" is designated by the robot changing switch 7, moving of new desired position and attitude, i.e., 
an operation from Fig. 13(b) to Fig. 13(c), are achieved by means of "mode of sole-acting each axis 
manual operation" of tool 2n or by means of "mode of sole-acting cartesian coordinates manual 
operation" with respect to the world coordinates system 51. These sole-action are described as 
follows. 

The explanation below are "mode of sole-acting each axis manual operation" or "mode of sole- 
acting cartesian coordinates manual operation" which are the state of the art of the present invention. 
The present controlling system is comprehensible to be a compound system which is capable to 
carry out not only "the mode of sole-acting each axis or cartesian coordinates manual opertation" but 
"the mode of co-acting each axis or cartesian coordinates manual operation". 
The "sole-acting each axis manual operation" is described below: 

[ 1 ] The operation of changing position and attitude of tool 2n into desired position and attitude thereof 
by means of actuating joints of tool handling robot 2 Is as follows; 

An operator chooses "toot handling robot" In the robot changing switch 7, "mode of each axis 
manual operation" in the mode changing switch 8 and "sole-action" in the operation changing switch 9 
on teach pendant 3. Moreover, a desired rate "r", e.g., 0.2, which is indicated as "r b * is chosen in the 
rate changing switch 10. An operator presses desired keys. e.g.. 12a and 12c. The procedure till 
they will be released are as follows; 

[ a ] : The first process consists of following [ a-1 ] to [ a-3 J. 

Actuating signals are inputted to control equipment by means of pressing keys 12a and 12c [ ST1 
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in Fig. 7 ]. As the operation changing switch 9 is "off", i.e.. being selected "sole-action" [ ST2 ] the 
mode changing switch 8 is "off", i.e.. being selected "mode of each axis manual operation" [ ST51 ] 
and the robot changing switch 7 is "off", i.e.. being designated "tool handling robot" [ ST52 in Fig. 17 
]. the procedure is led to step 53. 

[ a-1 J ; Velocities for joints of tool handling robot 2 are calculated as follows; 

The velocities V1 t ,V2, .V3, ,V4, ,V5t .V6, are computed by use of actuating signals S1 , S2 , 

S3 . S4 , S5 , S6 generated by keys, a designated rate • r b " and maximum values V1, 0 . V2«, . 

V3, 0 . V4 10 . V5, 0 . V6t 0 memorized in a velocity table for "each axis manual operation " of tool 

handling robot 2 [ ST53 J, from equations (32). 

VI, = S1 x r b x V1 l0 

V2, = S2 x r b x V2t„ 

V3 f = S3 x r b x V3ro 

V4, « S4 x r b x V4 t0 

V5, = S5 x r b x V5, 0 

V6, - S6 x r b x V6, 0 (32) 



The above-mentioned S1. S2 , • • • , S6 are as follows; 
pressing each of keys 12a - 12f produces a signal n + 1 " respectively, 
pressing each of keys 12A - 12F produces a signal "-1 " respectively, 
releasing each of keys 12a ~ 12f. 12A - 12F produces a signal "<T respectively. 
Since keys 12a and 12c only are pressed in this example, similar to the above-mentiond example, 

V2, = 0, V4t = 0. V5t = 0. V6t = 0. 



[ a-2 ] ; "Joint variables" ^ - 0l 0 2 - o . • . e 6 -o of tool handling robot 2 at the starting time of 

manual teaching operations are inputted [ ST54 ]. 

[ a-3 ] ; Setting up i.e.. i = 0. and a lapse of time At, from the starting time of manual operations is 

set up equal to "0" { ST55). 
[ b ] : The second process is as follows; 

The discrimination of whether keys 12a and 12c previously pressed have been released or not, 
i.e.. whether actuating signals are maintained or not. is carried out [ ST56 in Fig. 18 ]. If all of 
actuating signals are maintained, a infinitesimal time of AT is added to the lapse of time A t, [ ST57, 
ST58 J. and carrying out the third process is commanded after the lapse of time is replaced with A t 
.hi. If all of keys 12a and 12c have been already released [ ST59 ]. the teaching operation is 
ternimated [ ST60 I ft keys have been pressed are different from previous ones. i.e.. the keys 12a 
and 12D have been already pressed instead of keys 12a and 12c [ ST59 J, the procedure is repeated 
from step 1 by use of new actuating signals thereof. 

[ c ] : The third process is as follows; This is carrying out by receiving the command from the second 
process. 

"Joint variables" e u . #m . # * • . 0« of tool handling robot 2 after the lapse of time A t„ ie 
after AT xi. are calculated [ ST61 J. 

Bu * 0i-o + VI, x A U 

02-i B *2-o ♦ V2 t x A ti 

*3h = *3-o * V3, x A t } 

fcw = 04.o + V4, x A t| 

*W ~ *5-o + V 5 , x A U 

*w = 0*o + V6, x A t» (33) 

Such "joint variables" $ u , e w . • • • . e w of tool handling robot 2 are transformed into actuating 
values a*., . a, 2 . it • • • • . a l6 ^ for actuators thereof by use of following equations (101 B) [ ST62 ] 
which are outputted just after the lapse of time comes into AtrfST63. ST64 J, and the procedure is 
returned to the second process. 

Bin = Qu /R|, 
a r 2-i = e 24 /H t2 
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a^i = 03.J /Rts 

a,w s *w/Rt$ (101B) 

This equation (101B) is the same with equation (101) mentioned above. 
[ 2 ] The operation of changing position and attitude of workpiece 1m into desired position and attitude 
thereof by means of actuating joints of workpiece handling robot 1 is as follows. This procedure is the 
same with that of changing position and attitude of tool 2n into desired position and attitude thereof by 
means of actuating joints of tool handling robot 2, which has been described in section [ 1 ]. 

An operator chooses "workpiece handling robot" in the robot changing switch 7, "mode of each axis 
manual operation" in the modo changing switch 8 and "sole-action" in tho operation changing switch 9 
on teach pendant 3. Moreover, a desired rate V, e.g., 0.5, which is indicated as "r c ■ is chosen in the 
rate changing switch 10. 

An operator presses desired keys, e.g., 12A and I2d. The procedure till they will be released are as 
follows: 

t a ] ; The first process consists of following [ a-1 ] to [ a-3 ]. 

Actuating signals are picked up to control equipment by means of pressing keys 12A and 12d [ 

ST1 in Fig. 7 J. As the operation changing switch 9 is "off", i.e., being selected "sole-action" [ ST2 ]. 

the mode changing switch 8 is "off", i.e., being selected "mode of each axis manual operation" [ 

ST51 ), and the robot changing switch 7 is "on", i.e.. being designated "workpiece handling robot" [ 

ST52 in Fig. 17], the procedure is led to step 65. 

[ a-1 ]; Velocities for joints of workpiece handling robot 1 are calculated as follows: 

The velocities V1 w ,V2w .V3* ,V4* ,V5* ,V6w are computed by use of actuating signals 81. S2, 
S3. S4. S5, S6 generated by keys, a designated rate r c " and maximum values Vlwo , V2wo , V 3** 
. V4*o . V5*o , V6wo memorized in a velocity table for "each axis manual operation" of workpiece 
handling robot 1 [ ST65 J. from equation (23C) which is the same with the above-mentioned 
equation (23). 

V1 W = 81 x r c x V1wo 
V2 W = S2 x r c x V2W0 
V3w * S3 x r c x V3wo 
V4 W = S4 x r c x V4wo 
V5w = S5 x r 0 x V5wo 
V6w = S6 x r c x VB^ (23C) 

The above-mentioned S1 , S2 , ■ • • , S6 are as follows; 
pressing each of keys 12a - 12f produces a signal " + 1" respectively, 
pressing each of keys 12A ~ 12F produces a signal "-I" respectively, 
releasing each of keys 12a - 12f. 12A - 12F produces a signal "0" respectively. 
Since keys 12A and 12d only are pressed in this example, similar to the above-mentiond example. 

V2 W = 0, V3w ■ 0, V5w = 0. V6w = 0. 



[ a-2 ] : "Joint variables" ^1-0,^2-0/ * * # workpiece handling robot 1 at the starting 

time of manual teaching operations are inputted [ ST66 J. 

[ a-3 J ; Setting up i = 0, and a lapse of time A U from the starting time of manual operations is 

set up equal to °0" [ ST67 ]. 
( b ] : The second process is as follows; 

The discrimination of whether keys 12A and I2d previously pressed have been released or not, 
i.e., whether actuating signals are maintained or not, is carried out [ ST68 in Fig. 19 ). If all of 
actuating signals are maintained, a infinitesimal time of A T is added to thelapse of time A ti [ ST69, 
ST70 ], and carrying out the third process is commanded after the lapse of time is replaced with a 
t lo . If all of keys 12A and 12d have been already released [ ST71 ], the teaching operation is 
temimated ( ST72 ]. If keys have been pressed are different from previous ones, i.e., the keys 12a 
and I2d have been already pressed instead of keys 12A and I2d [ ST71 J, the procedure is repeated 
from step 1 by use of new actuating signals thereof. 
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[ c ] : The third process is as follows; This is carrying out by receiving the command from the second 
process. 

-Joint variables" # M . * 6 .. of workplece handling robot I after the lapse of time A L, 

i.e., after AT xi, are calculated [ ST73 J. 



♦u = *l-o ♦ Vl t x At, 
- to* + V2, x A t| 
♦w a 4>3-o + V3, x A t| 
<t>4A c $4-o + V4j X A t, 
*64 B *5*o + V5, x A U 
0*4 « feo + V6, x A t, (33C) 



This equation (33C) is the same with equation (33) mentioned above. 

Such "joint variables" ^ of workpiece handling robot 1 are transformed into 

actuating values a*,., , • • • • , a**., for actuators thereof by use of following equations (102C) [ 
ST74 ], which are outputted just after the lapse of time comes into At, [ ST75, ST76 ] f and the 
procedure is returned to the second process. 



3wW 53 $3-1 / Rw3 

a*e-i = ^/Rwe (102C) 



This equation (102C) is the same with equation (102) mentioned above. 
Next, "sole-acting cartesian coordinates manual operation" is described below: 
[ 3 ] The operation of changing position and attitude of tool 2n into desired position and attitude thereof 
with respect to the world coordinates system 51 by means of actuating joints of tool handiinq robot 2 is 
as follows; 

An operator chooses "tool handling robot" in the robot changing switch 7, "mode of cartesian 
coordinates manual operation" in the mode changing switch 8 and "sole-action" in the operation 
changing switch 9 on teach pendant 3. Moreover, a desired rate V, e.g., 0.2, which is indicated as "r h - 
is chosen in the rate changing switch 10. 

An operator presses desired keys, e.g., 12b and 12c. The procedure till they will be released are as 
follows; 

[ a ] : The first process consists of following [ a-1 ] to [ a-3 ]. 

Actuating signals are inputted to control equipment by means of pressing keys 12b and 12c [ ST1 
in Fig. 7 J. As the operation changing switch 9 is "off", i.e., being selected "sole-action" [ ST2 ) the 
mode changing switch 8 is "on", i.e.. being selected "mode of cartesian coordinates manual 
operation" [ ST51 ]. and the robot changing switch 7 is "off", i.e., being designated "tool handling 
robot" [ ST82 in Fig. 20 ], the procedure is led to step 83. 

[ a-1 J; Velocities for translation and rotation of tool 2n in the world coordinates system 51 are 

calculated as follows; 

The velocities Vx, ,Vy t ,Vz, ,Va, ,VA ,V 7l are computed by use of actuating signals Sx . Sy , 
Sz , Sa , , Sy generated by the keys, a designated rate "r b " and the maximum values Vx*, . 
Vy, 0 . Vz,o . Vor t0 , Vfto . V 7t0 memorized in a velocity table for "cartesian coordinates manual 
operation" of tool 2n [ ST83 ]. from equations (35). 

Vxt = Sx x r b x Vx,o 
Vy» * Sy x r b x Vy t0 
Vz, = Sz x r b x Vzto 
Va, = Sa x r b x Va t0 
V/S t = S0 x r b x Vfto 
Vy, = S7 x r b x V 7|0 (35) 

The above-mentioned Sx. Sy . * • * ,Sy are as follows; 

pressing each of keys 12a - 12f produces a signal " + 1 * for each output; 
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pressing each of keys 12A - 12F produces a signal "-r for each output; 

releasing each of keys 12a - 12f, I2A ~ 12F produces a signal *<T for each output. 
Since the key 12b and 12c only are pressed in this example, similar to the above-mentioned 
example, 

Vx, = 0. Va, = 0. Vfi t = 0. V 7t = 0. 



[ a-2 ] ; "Joint variables" 01 - 0 . 02 -o. • # • • , 0b -o of tool handling robot 2 at the starting time of 
manual teaching operations are inputted [ ST84 J. And a homogeneous transformation matrix " 
world X,^> " of position and attitude of the tip point 57 of tool 2n with respect to the world 
coordinates system 51 is calculated as a following equation [ ST85 ]. 



world X™ = Z, * T 2 -o * E, (36) 

Equation (36) is formulated as a following equation. 



world Xi-o - 



n x Ox 3x P x 
Ily Oy ay py 



n , 



O s a f pi 



(37) 



By transforming the above equations, the data for position X Y lK) , Z tK) and the data of 
Euler's angles an, . 0^ , y ^ for attitude of the tip point 57 of tool 2n with respect to the world 
coordinates system 51 at the starting time of manual operations are obtained. The 6 equivalent 
parameters are calculated by following equations . 
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world Xt-<> =Trans(Xt- 0 . Y t - Q , Z t - 0 ) -Rot(Z, c* t -o ) 

• Rot ( Y . 0 t- 0 ) • Rot(Z , r t-o ) 



Cos (or t-o ) Cos(£t- 0 ) Cos(n-o ) -Sin(ar t - 0 ) Sin(r t-o ) 
Sin(art-o ) Cos(0 t -o ) Cos(rt-o ) + Cos(cr t -o ) Sin(rt- 0 ) 
-$in(£ t -o ) Cos(r t-o ) 
0 



-Cos(of t -o ) Cos(£ t -o ) Sin(rt-o ) -Sin(a t - 0 ) Cos(r t-o ) 
-Sin(ar t -o ) Cos(/?t-o ) Sin(rt-o ) -Cos(ar t -o ) Cos(r t-o ) 
Sin(0 t -o ) Cos(r t-o ) 
0 



Cos(* t -o ) Sin(£ t -o ) Xt-o 

Sin(of t -o ) Sin(£t-« ) Yt-o 
Cos(£ t -o ) Zt-o 
0 1 



Xi-o = Px . Y tH0 = py , Z,^ * p 2 (38) 
cth> = Cos- 1 (a* /Sin(A« ) ) (39) 
fa = Cos" 1 (a 2 ) (40) 

= Sin' 1 (o 2 /Sin(^)) (41) 

By use of these equations (38). (39), (40) and (41), position and attitude of tool 2n are 
calculated [ ST86 ]. 

[ a-3 ] ; Setting up i ■ 0, and a lapse of time A from the starting time of manual operations is 

set up equal to "0" [ ST87 ]. 
( b ] : The second process is as follows; 

The discrimination of whether the keys 12b and 12c previously pressed have been released or 
not, i.e., whether the actuating signals are maintained or not, is carried out [ ST88 in Fig. 21 J. If all of 
actuating signals are maintained, a Infinitesimal time AT is added to the lapse of time 6 l, I ST89, 
ST90 J. and carrying out the third process is commanded after the lapse of time is replaced with A 
tm- If all of the keys 12b and 12c have been already released [ ST91 J. the teaching operation is 
terminated [ ST92 J. If the keys have been pressed are different from previous ones, i.e.. the keys 
12C and 12F have been already pressed instead of the keys 12b and 12c [ ST91 ), the procedure is 
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| repeated from step 1 by use of new actuating signals thereof. [ c ] : Tne third process is as follows; 

$ This is carrying out by receiving the command from the second process. 

| Position X M , Y l4 , Z u and Euler's angle a t j . 0 t . , , yu of the attitude of the tip point 57 of tool 2n 

| with respect to the world coordinates system 51 after the lapse of time At -i, i.e.. after ATxi, are 

U 5 calculated. 

il x.., = x^, + v X| x a t, 

'i Y w «= + Vy, x A Li 

| Z,., = Z|^, + Vz t x A t| 

| JO * a|.o + Va t x A t| 

I 0 U = + V0, x A t« 

| = 7t-o * V71 x A t) (42) 

I 

si' 

i| A homogeneous transformation matrix " world X H " of position and attitude of the tip point 57 of 

| J5 tool is calculated as a following equation. 

| world X,., =Trans(Xn , Y H , Z H ) • Rot(Z. a H ) • Rot(Y, fi u ) • Rot(Z, 7H ) (43) 

I 

| Since position and attitude T 2 .j of tool handling robot 2 is expressed as a following equation (44) 

| 20 similar to above-mentioned equation (20), "joint variables" , 0 2 . ( . • * * , Ha of tool handling robot 

| 2 are obtained [ ST93 ]. 

I 

| T a , = (Z, ) • world Xw, • wX, • (E t ) (44) 



25 Such "joint variables" B u . Ha . * • * . 0s-i of tool handling robot 2 are transformed into actuating 

values a,vi . a« * • • • • , a, 6 4 for actuators thereof by use of following equations (101 D) [ ST94 ], 
which are outputted just after the lapse of time comes into A U [ ST95, ST96], and the procedure is 
returned to the second process. 

30 a,,., = $ u /Rti 

a t2 .» a Bia l R t2 

ata-t = Ha / Rta 

3t4w = Baa f Rt4 

atw = Ha / Rts 
35 a, w ■ fiw/Rte (101D) 

This equation (101 D) is the same with equation (101) mentioned above. 
[ 4 ] The operation of changing position and attitude of workpiece 1m into desired position and attitude 
thereof with respect to the world coordinates system 51 by means of actuating joints of workpiece 
40 handling robot 1 is as follows; 

An operator chooses "workpiece handling robot" in the robot changing switch 7, "mode of cartesian 
coordinates manual operation" in the mode changing switch 8 and "sole-action" in the operation 
changing switch 9 on teach pendant 3. This means "sole-acting cartesian coordinates manual operation 
of workpiece handling robot". Moreover, a desired rate V, e.g., 0.5. which is indicated as "r c " is chosen 
45 in the rate changing switch 10. 

An operator presses desired keys, e.g.. 12a and 12c. The procedure till they will be released are as 
follows; 

[ a J : The first process consists of following [ a-1 ] to [ a-3 J. 

Actuating signals are taken into control equipment by means of pressing keys 12a and 12c [ ST1 
so in Fig. 7 J. As the operation changing switch 9 is "off", i.e., being selected "sole-action" [ ST2 ], the 

mode changing switch 8 is "on", i.e., being selected "mode of cartesian coordinates manual 
operation" [ ST51 ], and the robot changing switch 7 is "on", i.e., being designated "workpiece 
handling robot" [ ST82 in Fig. 20 J, the procedure is led to step 100 in Fig. 20. 

A workpiece handling robot 1 may be a manipulator of 6 degrees of freedom or a positioner of 
55 less than 3 degrees of freedom. A manipulator of 6 degrees of freedom only is. however, applied to 

the control in this embodiment of the present invention, therefore, in step 100 it is discriminated 
whether workpiece handling robot 1 is a manipulator of 6 degrees of freedom or not. 

As the degree of freedom of workpiece handling robot 1 is previously stored in the "control 
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means for manual teaching operations" 4A. the discrimination of whether workplace handling robot 1 
is 6 degrees of freedom is carried out by means of said stored signal. If workpiece handling robot I Is 
a positioner, a message that the procedure for controlling later is impossible is indicated in an 
undrawn CRT etc. [ ST101 J, the procedure is terminated at thai time [ST102 ]. If workpiece handlinq 
* robot 1 is 6 degrees of freedom [ ST100 J, the procedure is led to step 103. 

[ a-1 J; Velocities for translation and rotation of workpiece 1m in the world coordinates system 51 
are calculated as follows; 

The velocities Vx* ,Vy w .V^ ,v« w ,V/5 W .V 7w are computed by use of actuating signals Sx , Sy 
. Sz , S« , S0 , S 7 generated by the keys, a designated rate *r c w and the maximum values Vx^ , 
'° vy*, , V 2w0 , V Ow0 , . V 7w0 memorized in a velocity table for "cartesian coordinates manual 

operation" of workpiece 1m [ ST103 ], from equations (45). 

Vx* » Sx x r c x Vx*o 
Vy w = Sy x r c x V yw0 
Vz* = $z x r e x Xz^o 
Va w s So x r c x V Ow0 
V^ w = S/S x r c x V/U 

= S 7 x r c x V 7w0 m 

20 The above-mentioned Sx, Sy , ■ • • ,Sy are as follows; 

pressing each of keys 12a - 12f produces a signal " + 1 ■ for each output; 

pressing each of keys 12A - 12F produces a signal *-r for each output; 

releasing each of keys 12a ~ 12f. 12A ~ 12F produces a signal "0" for each output 
Since the keys 12a and 12c only are pressed in this example, similar to the above-mentioned 
25 example. 

Vy w * o, Va w * 0, V/8 W * 0. V 7w = 0. 



30 
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I a-2 J ; "Joint variables" *,- 0 , fe- 0 , • • ■ ■ , * s - 0 of workpiece handling robot 1 at the starting 
time of manual teaching operations are inputted [ ST104 J. And a homogeneous transformation 
matnx " world X^ - of position and attitude of the referential point 56 of workpiece 1m with 
respect to the world coordinates system 51 is calculated as a following equation [ ST105 ). 

world X™ = Z w • T 2 -o • Ew (46) 

Equation (46) is formulated as a following equation. 



40 



45 



50 



world X, 



n * 
n y 

n z 



O x 

O y 
O 8 



a x 

a y 

a z 
0 



P X 

P y 
P z 
1 



J 



(47) 



55 



By transforming the above equations, the data for position X WH) , Y WK> , and the data of 
Euler's angles a w . 0 , ^ , 7w ^ for attitude of the tip referential point 56 of workpiece 1m with 
respect to the world coordinates system 51 at the starting time of manual operations are obtained 
The 6 equivalent parameters are calculated by following equations . 
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world Xw-o = s Trans(X w -o , Y w -o • Zw- 0 ) *Rot(Z. ) 

* Rot(Y, i9w- 0 ) • Rot(Z, r w-o ) 



Cos(of w -o ) Cos(/?w-o ) Cos(r w-o ) -Sin(c*w-o ) Sin(rw-o ) 

Sin(or w -o ) Cos(£w-o ) CosCr*-© ) + Cos(afw-o ) Sin(r w-o ) 
~Sin(/? w -o ) Cos( r w-o ) 
0 



Cos(c*w-o ) Cos(/?w-o ) Sin(r«-o ) 
Sin(arw-o ) Cos(/? w -o ) Sin(rw-o ) 
Sin( B w-o ) Cos( r w-o ) 
0 



Sin(<* w-o ) Cos( r *-o ) 

C0S( OTw-o ) C0S( r w-o ) 



Cos(afw-o ) Sin(0 w -o ) 
Sin(or w -o ) Sin(i9 w -o ) 
Cos (0 w-o ) 
0 



Xw-o = Px . Y WK) = py , 2 W ^ = p z (48) 

«w* = Cos" 1 <a x /Sin(£ w « ) ) (49) 

/9 WH> = Cos" 1 (a, ) (50) 

7wh> = Sin" 1 (o, /Sintfw^ ) ) (51) 

By use of these equations (48). (49). (50) and (51). position and attitude of workpiece 1rn are 
calculated [ ST106 ]. 

[ a-3 ] ; Setting up i = 0, and a lapse of time A U from the starting time of manual operations is 

set up equal to "0" [ ST107 ]. 
[ b ] : The second process is as follows; 

The discrimination of whether the keys 12a and 12c previously pressed have been released or 
not. i.e., whether the actuating signals are maintained or not. is carried out [ ST 108 in Fig. 23 ). If all 
of actuating signals are maintained, a infinitesimal time AT is added to (he lapse of time A u ( ST109, 
ST1 10 ], and carrying oul the third process is commanded after the lapse of time is replaced with A 
ti*i. If all of the keys 12a and 12c have been already released [ ST111 I the teaching operation is 



Xw-o 
Z w- o 

1 
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terminated [ ST112 J. if the keys have been pressed are different from previous ones, i.e., the keys 
1 2a, 12c and 12E have been already pressed instead of the keys 12a and 12c [ ST11! J, the 
procedure is repeated from step 1 by use of new actuating signals thereof. 

[ c ] : The third process is as follows; This is carrying out by receiving the command from the second 
5 process. 

Position X^,Y wA . and Euler's angle a w ., , fa , 7<M of the attitude of the referential point 58 
of workpiece 1m with respect to the world coordinates system 51 after the lapse of time At -1 i e 
after ATx i, are calculated. 

™ = + Vxw * A U 

Ywi s Yw-o + Vy w x A tj 

Z^ = + Vzw x A U 

<*wA 53 Ow-o ♦ Va w x At, 

&h = fiwo + Vj9 w x A t| 
'5 Yvh ~ 7wk> ♦ V >w x A t, (52) 

A homogeneous transformation matrix ■ world X„ - of position and attitude of the referential point 
56 of workpiece is calculated as a following equation. 

20 world = TransfX^, , , Z*.,) • Rot(Z, ) • Rot(Y, fa ) • Rot(Z, y w4 ) (53) 

Since position and attitude W 2 .| of workpiece handling robot 1 is expressed as a following 
equation (54) similar to above-mentioned equation (22), "joint variables" <t>u . . * ■ • <j> 6 < of 
workpiece handling robot 1 are obtained [ ST1 13 ]. 

25 

W 2 _, = (Z w ) - 1 • world X*., • (Ew ) (54) 

Such joint variables . #w . • • • , 4w of workpiece handling robot 1 are transformed into 
actuating values a^., , a^, * • # * . a^-j for actuators thereof by use of following equations (102E) [ 
30 ST114 ], which are outputted just after the lapse of time comes into A u [ ST115, ST116 ], and the 

procedure is returned to the second process. ^ ~ 

= / Rwi 

3wW = ^2-1 / Rw2 

a^^ = $44 I Pw4 

aw5-l * *S4 /Rws 

a**! = <>eW Rwe (102E) 

40 This equation (102E) is the same with equation (102) mentioned above. 

In above-mentioned "co-acting cartesian coordinates manual operations", the world coordinates system 
is applied to the coordinates system in order to regulate movement of axial directions of each axis or 
rotation around each axis in the cartesian coordinates relating to position and attitude of workpiece handling 
robot 1. The coordinates system at the base point 52 of the workpiece handling robot 1 as shown in Fig. 5 

45 may be applied to the coordinates system related to the present invention instead of the world coordinates 
system. 

In such case, equations (6), (7), (8), (9) and (10) in the first process are replaced with following ones. 
A homogeneous transformation matrix " wl X^ ■ of position and attitude of the referential point 56 of 
workpiece with respect to the base point 52 of workpiece handling robot 1 is as follows; 

wiXw« = W?-o * Ew (6X) 

where a matrix W 2 - 0 is given by equation (3), and E w is a homogeneous transformation matrix of position 
and attitude of the referential point 56 of workpiece with respect to the holding point 53 of workpiece Im. 
The data of this Ew is previously stored, as an example mentioned above, in the "control means for manual 
teaching operations- 4A. 

A homogeneous transformation matrix " nX^ • of position and attitude of the tip point 57 of tool 2n 
with respect to the base point 54 of tool handling robot 2 is as follows; 

25 



50 
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tiX IK) = T 2 -o • E, (7X) 

wh8re a matrix T 2 - 0 is given by equation (5), and E| is a homogeneous transformation matrix of position 
5 and attitude of the tip point 57 of tool with respect to the installation point 55 of tool 2n. The data of this E t 
is also previously stored, as an example mentioned above, in the "control means for manual teaching 
operations" 4A. 

A following equation (8X) is formulated by use of a homogeneous transformation matrix 2 W of position 
and attitude of the base point 52 of workpiece handling robot 1 with respect to the world coordinates system 
io as shown in Fig. 5, a homogeneous transformation matrix Z, of position and attitude of the base point 54 of 
tool handling robot 2 with respect to the world coordinates system, and a homogeneous transformation 
matrix wX t of position and attitude of the tip point 57 of tool 2n with respect to the referential point 56 of 
workpieco. 

»5 Z, • TiX,K, ■ Zw ' *.Xwo # wX t (8X) 

Therefore, wX, is calculated from a following equation. 
wX, = ( wl X^ ) -* • Z w • Z, • tiXh, (9X) 



20 



A homogeneous transformation matrix w1 Xw 0 of position and attitude of the referential point 56 of 
workpiece with respect to the base point 52 of workpiece handling robot 1 is as follows; 
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I l X w- < 



n x 
n y 

n z 
0 



o x 

0 y 
O s 

0 



a x 
a y 
a z 
0 



P X 

P y 

P z 
1 



(10X) 



40 
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And equations (16), (17), (18), (19), (20) (21) and (22) in the third process are replaced with following 
ones. 

A homogeneous transformation matrix ^X^ of position and attitude of the referential point 56 of 
workpiece with respect to the base point 52 of workpiece handling robot 1 is calculated from equation 
(16X). 

wiX^ = Trans(X*., , Y*., , Z* A ) • Rot(2, a w ., ) • Rot(Y, 0 wA ) • Rot(Z, 7w .i ) (16X) 

Even if workpiece 1m acts according to equation (16X), position and attitude T 2 ^ , which relative 
position and attitude of tool 2n against workpiece 1m are never changed, of tool handling robot 2 can be 
calculated as follows. 

A following equation (18X) is formulated as the above-mentioned equation (8X). 



Z, • tiXh = Z w • wtX^ • wX t (17X) 

A following equation is formulated from the relation of coordinates as the above-mentioned equation (7X). 
55 tiX h = T 2 -o * E t (18X) 

From equation (18X), a following equation (19X) is formulated. 
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T 24 = ^ (E, ) - 1 (19X) 

Substituting equation (17X) into equation (19X) results equation (20X). 
T 2 4 » (2, ) - 1 • 2w • w1 X^, • wX, • (E, ) (20X) 

On the other hand, equation (21X) is formulated as an above-mentioned equation <6X). 
wiX* 4 = W 2 ^ • (21 X) 

and a homogeneous transformation matrix W 2 . k of position and attitude of workpiece handling robot 1 can be 
calculated by equation (22X). 

WV, = wf X*, * (Ew) -* (22X) 

In the teaching operations by use of "co-acting manual operation-, as described above "actuating 
values for actuators" of the workpiece handling robot and "actuating values for actuators" 'of the tool 
handling robot are computed by means of estimating a state after a previously fixed constant infinitesmal 
time. When the lapse of time comes into a predetermined time, "actuating values for actuators" of the tool 
handling robot and "actuating values for actuators" of the workpiece handling robot are synchronously 
outputted. therefore, the joints of the workpiece handling robot and joints of the tool handling robot are 
actuated according to the output signals respectively. 

As the co-action which associates the workpiece with the tool while pressing the keys is synchronously 
achieved, the relative position and attitude of the tool against the workpiece is always constant, which is a 
specific effect of the present invention. In addition, the relative position and attitude of the tool against the 
workpiece is stopped maintaining previous ones after releasing the keys. 

When the keys are released, the robots are really stopped after the above-mentiond infinitesimal time 
but the movement of workpiece and tool are not influenced if a preferable rate is selected In the rate 
changing switch. And the workpiece and the tool are acculately stopped at a desired position by means of 
movement till the vicinity of a target in a high speed and movement close to said target in a lower speed. 

The rapid and simplified teaching operations are established owing to unnecessity of retiring the tool 
from the workpiece in order to avoid interference of the tool with the workpiece. Even if position and attitude 
of the workpiece are changed, relative position and attitude of the tool against the workpiece are never 
changed. Therefore, it becomes easy to find position and attitude of the tool against the workpiece at the 
last teaching point, enabling a correct teaching at a next desired point. 

Claims 

1. A teaching control device for manual operation in an industrial robots-system, which is provided with a 
workpiece handling robot (1) that is capable to change position and attitude of a workpiece (1m) and a 
tool handling robot (2) that is capable to change position and attitude of a tool <2n) processino said 
workpiece (1m) t comprising: 

a selecting means for sole-action/co-action (9) for enabling to select sole-acting manual operation 
that facilitates changing position and attitude of workpiece (1m) on said workpiece handling robot (1) 
and changing position and attitude of tool (2n) on said tool handling robot (2) separately, or to select 
co-acting manual operation that facilitates changing position and attitude of tool (2n) on said tool 
handling robot (2) co-acting with changing position and attitude of workpiece (1m) on said workpiece 
handling robot (1) so that position and attitude of the tool (2n) against workpiece (1m) can be always 
kept constant; 

a teaching key means (12) outputting actuating signals for changing position and attitude of said 
workpiece (1m); 

a control means for manual teaching operators (4A) carrying out control according to the after- 
mentioned process by means of receiving actuating signals from said teaching key means (12) and a 
co-acting signal from said selecting means for sole-action/co-action (9); 

said control means for manual teaching operaloins (4A) is a computer carries out control compris- 
ing following processes; 

the first process consists of taking actuating signals and computing position and attitude of 
worxpiece handling robot (1) at the starting time of manual teaching operations and position and 
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attitude of tool (2n) against workpiece <im) at the starting time of manual teaching operations; 

the second process consists of commanding to carry out the following third process by means of 
estimating the state after a preset infinitesimal time ( AT ). when actuating signals in the first process 
are maintained, and commanding to return to the first process when actuating signals have already 
changed into different ones, and commanding to terminate teaching operations, when actuating signals 
have already vanished; 

the third process consists of not only calculating position and attitude of workpiece handling robot 
(1) but previously calculating position and attitude of tool handling robot (2) by means of position and 
attitude of tool (2n) against workpiece (1m) at the starting time of manual teaching operations, which 
were calculated at the first process, and by means of position and attitude of workpiece handling robot 
(1) at the starting time of manual teaching operations, which were calculated at the first process; 

tho fourth process consists of only calculating joint variables of workpiece handling robot (1) by 
means of position and attitude of workpiece handling robot (1) which were calculated at the third 
process but calculating joint variables of tool handling robot (2) by means of position and attitude of tool 
handling robot (2) which were calculated at the third process; 

The fifth process consist of not only previously calculating actuating values (a^ u . a*M , • • • , 
a^) for actuators of workpiece handling robot (1)1 by means of joint variables ( *i , * 2 . * * * , *c ) 
of workpiece handling robot (1) 1 which were calculated at the fourth process but to previously 
calculating actuating values ( a t 14 , a, 2 . t , • • • , a^) for actuators of tool handling robot (2) 2 by 
means of joint variables (0i , 9 2 . * * * , o<, ) of tool handling robot (2) which were calculated at the 
fourth process, in addition, including not only to output signals of actuating values (a^ , a w2-t . * * * . 
a^) for actuators of workpiece handling robot (1) 1 and signals of actuating values (a^ , a^ . • ■ • , 
at$4) for actuators of tool handling robot (2) 2 at the same time just after an infinitesimal time ( AT ). but 
to command repeating on and after the second process. 

A teaching control device for manual operations according to claim 1. wherein: 
said actuating signals of the teaching key means (12) may be adopted the signals commanding 
translation along each axis or rotation around each axis in the cartesian coordinates of position and 
attitude of workpiece handling robot (1). 

A teaching control device for manual operations according to claim 1, wherein: 

said actuating signals of the teaching key means (12) may be adopted the signals commanding 

motions of joints ( 1a, 1b, 1c, id, 1e, tf ) of workpiece handling robot (1). 
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(node of 
each axis manual 
operation) 



ST 6 



YES (mode of cartesian coordinates manual 

operation) 

NO 

ST 8 



STl 0 




velocities Vx w Vy„ Vz« Va„ 
V£„ V rw for cartesian coordinates 
manual operation of a workpiece are 
calculated by use of eq. (1). 



( END )^ST9 



joint variables <f> i- 0 < 
^6-o of workpiece hanc 
time of manual operatio 


02-0 ^3-0 04-0 

ling robot at starting 
n are inputted. 






joint variables 6 1 . 0 0z-o 0j-o d 4 -o S 5 - 0 
d *- 0 of workpiece handling robot at starting 
time of manual operation are inputted. 



/-ST 1 1 



STl 2 



homogeneous transformation 
position and attitude of wo 
world coordinates system at 
operations is calculated fr 


matrix "world XwV of 
rkpiece with respect to 
starting time of manual 
om eq. (6). 






homogeneous transformation matrix 'world X w . 0 " of 
position and attitude of tool with respect to world 
coordinates system at starting time of manual 
operations is calculated from eq. (7). 



•STl 3 



STl 4 
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1 



homogeneous transformation matrix wXt of position 
and attitude of tip point of tool with respect to 
the referential point of workpiece at starting time 
of manual operations is calculated from eq. (9). 



ST1 5 



position of referential point of workpiece with respect 
to world coordinates system at starting time of manual 
operations is calculated from eq, (11), and Euler's 
angles are calculated from eqs. (12), (13), (14). 



'ST1 6 




ST1 9 — 
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positions and Buler's angles of referential point of 
workpiece with respect to world coordinates system after 
lapse of time A t-i are calculated from eq. (15). 

i 



ST 2 3 



world X 



W-i 



is calculated from eq. 



(16). 



homogeneous transformation matrix TVi of 
position and attitude of tool handling robot 
are calculated from eq. (20). 

♦ 



homogeneous transformation matrix W 2 -i of 
position and attitude of workpiece handling 
robot are calculated from eq. (22). 
— — — f~ 



joint variables of tool handling robot are 
calculated by inversely transforming Tz-i 



ST 2 4 



ST2 5 



ST2 6 



•ST2 7 



joint variables of workpiece handling robot are 
calculated by inversely transforming W 2 -i . 



ST 2 8 



actuating values for actuators based on joint variables 
of tool handling robot and actuating values for 
actuators based on joint variables of workpiece handling 
robot are calculated from eqs. (101) and (102). 




r^r^-^^sT3 o 

es into 
YES 


NO ^aps 

<dT time com 



ST 2 9 



actuating values a ti-i» a t z-i» * • •• at6-i for 
actuators of tool handling robot are outputted, and the 
actuating values am-i, a*z-i, • * *, a w6 -i for 
actuators of workpiece handling robot are outputted. 



ST 3 1 
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FIG. 14 



velocities VI* V2w V3 W V 4* 
V 5 w V 6 w for each axis manual 
operation of workpiece handling robot 
are calculated by use of eq. (23). 



ST 3 2 



joint variables t t . 9 ^ 2 . 0 ^ 3 - 0 4a-o tf 5 -o 
^6-o of workpiece handling robot at starting 
time of manual operation are inputted. 



ST 3 3 



joint variables 6 1- 0 0 2 -o 0 3 -o 04-o 0s-o 
0 6-o of tool handling robot at starting time 
of manual operation are inputted. 



ST 3 4 



homogeneous transformation matrix "world X w -o" 
of position and attitude of workpiece with respect 
to world coordinates system at starting time of 
manual poerations is calculated from eq. (6A). 



ST3 5 



homogeneous transformation matrix 'world Xt-o" 
of position and attitude of tool with respect to 
world coordinates system at starting time of 
manual operations is calculated from eq. (7A). 



ST 3 6 



homogeneous transfotmation matrix wXt of position 
and attitude of tip point of tool with respect to 
referential point of workpiece at starting time of 
manual operations is calculated from eq. (9A). 



ST3 7 



i = 0 



ST3 8 
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FIG. 16 



I 



joint variables ^i-i j t -i ^3-» <*4-i 
s-i of workpiece handling robot 
after lapse of time A t.i are calculated 
from eq. (24). 



/-ST4 4 



homogeneous transformation matrix W 2 -i of 
position and attitude of workpiece 
handling robot is calculated from eq. (26). 



T 



ST 4 5 



homogeneous transformation matrix TVi 
of position and attitude of tool handling 
robot is calculated from eq. (31) 



joint variables of tool handling robot are 
calculated by inversely transforming Tz-i 



ST 4 6 



ST4 7 



actuating values for actuators based on joint 
variables of tool handling robot and actuating 
values for actuators based on joint variables 
of workpiece handling robot are calculated 
from eq. (101) and (102). 



ST4 8 




actuating values a t i-i. a t *~i. • • •. a t 6-i for 
actuators of tool handling robot are output ted, and the 
actuating values a*i-i, a M i- if • • a*6-i for 
actuators of workpiece handling robot are outputted. 
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FIG. 18 



® 



ST 5 6 
:tuating""~~- — NO 
intained 




At.i =TXi 



•ST 5 8 



( 



joint variables of tool handling 
robot are calculated from eq. (33)* 



( END ^ ST6 0 



actuating values for actuators are 
calculated fron joint variables of 
tool handling robot by ues of eq. 
(1MB) . 



ST 6 1 



ST 6 2 




ST 6 3 



actuating values ati-i atz-i* 
• • a t6 -i for actuators of tool 
handling robot are output ted. 



ST 6 4 
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FIG. 19 




At-i =TX i 



YES 

( END y ^STl 2 



ST 7 0 



© 



joint variables of workpiece 
handling robot are calculated 
from eq. (33C). 



ST7 3 



actuating values for actuators are 
calculated from joint variables of 
workpiece handling robot by use of 
eq. (102C). 



ST 7 4 




ST7 5 



YES 



actuating values a w i-i, a W 2-i. • • •• 
a W 6-i for actuators of workpiece handling 
robot are output ted. 



ST 7 6 
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FIG. 2 0 




YBS (workpiece handling robot) 



(tool handling robot) 



velocities Vx t Vy t Vz» Va x Vn 
for cartesian coordinates manual operation 
of tool are calculated by use of eq. (35) . 



ST 8 3 



® 



i 



joint variables 0 x - 0 6 2 - 0 03-o 
4-0 ffs-o 9 6-0 of tool handling 
robot at starting tine of manual 
operation are inputted. 



ST 8 4 



homogeneous transformation natrix "world XtV of 
position and attitude of tip point of tool with 
respect to world coordinates system at starting time 
of manual operations is calculated from eq. (36). 



ST 8 5 



position of tool with respect to world coordinates 
system at starting tine of manual operations is 
calculated from eq.(38)> and Euler's angles are 
calculated from eqs. (39) . (40) , (41) . 



ST8 6 



i = 0 ^ST8 7 
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joint variables 8 t -i 6 z -i 
d j-i 6 4-i 6 s-i of tool 
handling robot are calculated 
from eq. (44) . 



C END ^ ST9 2 
•ST93 



actuating values for actuators are 
calculated from joint variables of 
tool handling robot by use of eq. 
(101D). 



ST 9 4 




ST 9 5 



actuating values a^i-i, a t z-», 
• * * . a i6 -i for actuators of 
tool handling robot are output ted. 



ST9 6 
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FIG. 2 2 



STl 0 0 




NO 



velocities Vx w Vy„ Vz w 
Vcr w V/? w Vrw for cartesian 
coordinates Manual operation of 
workpiece are calculated by use 
of eq. (45). 



y-ST103 . 


STl 0 1 

f 


error message is indicated 







joint variables 0i-o 0z-o 03-© 
^4-0 ^5-0 0*-o of workpiece 
handling robot at starting time of 
manual operation are inputted. 



-ST 1 0 4 



homogeneous transformation matrix "world X w .o" 
of position and attitude of referential point of 
workpiece with respect to world coordinates 
system at starting time of manual operations is 
calculated from eq. (46). 



STl 0 5 



position of workpiece with respect to world 
coordinates system at starting time of manual 
operations is calculated from eq. (48). and 
Euler's angles are calculated from eqs. (49) 1 
(50) ,(51). 



STl 0 6 



1 



-STl 0 7 
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FIG. 2 3 

© 



•ST 1 0 8 
;tuating NO 



ST1 0 i - i + 1 




ST1 1 1 
NO 



ST1 1 0^ A t -i =Tx i 



joint variables of workpiece 
handling robot are calculated 
from eq. (54). 



( END ) ^-STl 1 2 
ST1 1 3 



actuating values for actuators are 
calculated froa joint variables of 
workpiece handling robot by use of 
eq. (102E). 



ST1 1 4 




ST1 1 5 



actuating values a w i-i. a w *-», * * *. 
a W 6-i for actuators of workpiece handling 
robot are output ted . 



ST1 1 6 
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